//import lejos.nxt.Button;
//import lejos.nxt.Motor;
//import lejos.nxt.SensorPort;
//import lejos.nxt.UltrasonicSensor;
//import lejos.robotics.navigation.DifferentialPilot;
//import lejos.util.Delay;
//
//public class SonicTest {
//	public static void main(String[] args) throws InterruptedException
//	{
//		int Speed=400;
//		UltrasonicSensor sonic=new UltrasonicSensor(SensorPort.S1);
//		Motor.A.setSpeed(Speed);
//		Motor.B.setSpeed(Speed);
//
//		while(!Button.ENTER.isPressed())
//		{
//			Thread.sleep(300);
//			int value=sonic.getDistance();
//			System.out.println(value);
//			if(value>25)
//			{
//				Motor.A.forward();
//				Motor.B.forward();
//			}
//			else
//			{
//				DifferentialPilot pilot = new DifferentialPilot(2.1f, 4.4f, Motor.A, Motor.B, true);  // parameters in inches
//				pilot.setRotateSpeed(30);  // cm per second
//				pilot.travel(5);         // cm
//				pilot.rotate(-90);        // degree clockwise
//				pilot.travel(-5,true);  //  move backward for 5 cm
//				while(pilot.isMoving())Thread.yield();
//				//pilot.rotate(-90);
//				//pilot.rotate(270);
//				//pilot.steer(-50,180,true); // turn 180 degrees to the right
//				//waitComplete();            // returns when previous method is complete
//				//pilot.steer(100);          // turns with left wheel stationary
//				Delay.msDelay(1000);
//				//pilot.stop();
//
//				Motor.A.rotate(-180, true);
//				Motor.B.rotate(-360, true);
//				Motor.A.stop();
//				Motor.B.stop();
//			}
//		}
//		Motor.A.stop();
//		Motor.B.stop();
//
//	}
//}